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A CONTROL SYSTEM AND METHOD FOR CONTROLLING ONE OR SEVERAL 
MANIPULATORS 

TECHNICAL FIELD 

The present invention relates to a control system for 
control of one or more manipulators, wherein the control 
system comprises one or more computers and drive units for 
controlling the manipulators. A manipulator is a movable 
mechanical unit, the movements of which are driven by one 
or more motors. The invention is applicable to all types of 
mechanical units, whose movements are controlled by a com- 
puter program. Examples of manipulators are industrial ro- 
bots and means of transport such as roller conveyors. The 
invention is especially useful in connection with the con- 
trol of industrial robots. 

The present invention also relates to use of the control 
system according to the invention for control of an indus- 
trial robot. 

The present invention also relates to a method for control 
of one or more manipulators. 



BACKGROUND ART 

An industrial robot comprises a plurality of arms that are 
rotatable relative to each other about a plurality of axes. 
The movements of the axes are driven by motors mounted on 
each axis. The speeds and accelerations of the axes are 
controlled by the control system of the robot that genera- 
tes control signals to the motors. The control system com- 
prises drives that control the motors by converting direct 
current to a variable alternating current in dependence on 
control signals from an axis computer. Each motor has a 
drive of its own. The control system may have one or more 
axis computers. Further, the control system comprises a 
main computer that is adapted to execute a program with 
instructions for the movements and that supplies the axis 
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computer with control instructions. These control instruc- 
tions are then transformed by the axis computer into con- 
trol signals for the drives. The function of the axis com- 
puter is thus to ensure that orders from the main computer 
5 are carried out. The task of the main computer is to plan 
the movement path of the robot, so-called path planning, 
and the task of the axis computer is to ensure that the 
robot completes the planned path. The control signals to 
the drives determine motor torque, motor speeds and drive 
10 currents for each axis. The main computer also has many 
other tasks, such as handling I/O systems, application 
programs, interpolation, and communication with external 
systems . 

15 A conventional control system for an industrial robot com- 
prises a coherent unit, where the different parts in the 
control system, such as main computer, axis computer and 
drives, are mounted in one and the same cabinet with a 
common power supply, a common interface externally, and a 

20 common casing. The control system is provided with an in- 
ternal bus for communication between the different parts. 

From European patent No. 728 559 Bl, it is known, instead, 
to arrange the drives directly on the robot. Each one of 

25 the drives is mounted adjacent to the motor the*t it is to 
control. This is advantageous since the cables between the 
drives and the motor will be shorter, which reduces the 
radiation of high-frequency electromagnetic waves, which in 
turn may cause disturbance. Another advantage of shorter 

3 0 cables is that the risk of incoming EMC disturbances on the 
control signals is reduced. 

It is common practice to have several robots arranged 
together in manufacturing cells or along a production line. 
3 5 In such applications, the robots are either provided with 

individual control systems or with a common control system. 
Such a common control system comprises a main computer or 
one or more axis computers as well as one drive unit per 
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robot. A drive unit comprises a plurality of drives, 
usually between six and nine drives depending on how many 
motors are to be controlled. The axis computers and the 
main computer communicate via an internal bus. 

5 

One disadvantage of these control systems is that they are 
inflexible. If it is desired, for example, to add a new 
function or replace some part of the control system, it is 
necessary today to intervene and make changes in the exist- 

10 ing control system. To be able to add more robots, the 

existing control system must either be oversized even from 
the start regarding computer utility and power supply, or 
the whole of or parts of the control system must be repla- 
ced or be rebuilt to obtain the necessary computer utility 

15 and power supply. 

SUMMARY OF THE INVENTION 

The object of the present invention is to provide a flex- 

2 0 ible control system for control of one or more manipula- 

tors. The fact that the control system is flexible means 
that it is easy to connect a new manipulator to the control 
system, to add a new function to the control system, and to 
replace some part of the control system. 

25 

This object is achieved according to the invention with the 
control system described in the introductory part of the 
description, which is characterized in that the control 
system comprises a plurality of separate modules, adapted 

3 0 to handle various functions, whereby each one of the modu- 

les has its own power supply and is adapted to communicate 
with at least one of the other modules, the computers and 
the drive units being arranged in the modules. Each module 
is autonomous and has its own well-defined interface with 
3 5 respect to the other modules. The separate modules may 

either be placed together or be geographically separated at 
suitable locations . 
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Because the functions of the control system have been divi- 
ded into a plurality of separate modules with their own 
power supply, it is easy to add a new function or to extend 
the capacity of the control system by connecting a new mo- 
dule. When something breaks down in the control system, the 
faulty module can simply be replaced. For each module that 
is added, the total power supply of the control system in- 
creases. If a new manipulator is to be connected to the 
control system, it is sufficient to connect' another module 
to upgrade the control system. Thus, the control system 
need not be oversized from the start. 

According to the invention, independent functional units 
are identified and separate modules with these functions 
are created. In this way, the need of information exchange 
between the modules is reduced, which implies that no high 
bandwidth is needed for the communication channels between 
the modules. This means that it is sufficient to use common 
simple standard protocols for the communication between the 
modules and thus inexpensive standard components may be 
used. 

According to a preferred embodiment of the invention, the 
control system comprises a separate main computer module 
and at least one separate drive module, the main computer 
being arranged in the main computer module and the axis 
computer being arranged in the drive module. This is ad- 
vantageous when it is desired to connect a new manipulator 
to the control system, since it is sufficient to connect a 
new drive module for upgrading the control system both with 
regard to power supply and computer utility. 

According to another preferred embodiment of the invention, 
the control system comprises at least two separate drive 
modules. Advantageously, each drive module is adapted to 
control one manipulator. By arranging each drive module to 
control one manipulator, a new drive module is readily con- 
nected each time a new unit is added. 



WO 03/103903 



5 



PCT/SE03/00933 



According to a further preferred embodiment of the inven- 
tion, said drive module comprises a drive unit comprising a 
plurality of drives . One advantage of mounting the drives 
together with the axis computer is that it will be easy to 
5 connect a new manipulator. The power supply to the drive 

module is adapted to the number of drives . When the control 
system is extended by another drive module, the power supp- 
ly is automatically adapted to the number of drives and 
hence to the number of connected manipulators . One advan- 
10 tage of mounting all the drives together in the same module 
is that this makes it possible to provide the drives with a 
"'• common cooling system. 

According to still another embodiment of the invention, the 
15 control system comprises a separate transformer module, 
which has a transformer and is adapted to transform the 
incoming ac voltage to the correct voltage level for the 
modules. Different countries deliver alternating current 
■ with different voltage levels. Whether a transformer is 
20 needed, and in that case which one, depends on the country 
in which the system is to operate. Because the transformer 
is arranged as a separate module, the module is easily re- 
placed if another transformer is needed. 

25 According to yet another embodiment of the invention, the 
control system comprises a separate control-panel module 
with the control panel of the control system. By arranging 
the control panel in a separate module, it is possible to 
integrate the control panel into some other piece of equip- 

3 0 merit so as to make it easily accessible to the operator. 

According to a further embodiment of the invention, each 
one of the modules is enclosed in its own casing. The 
casing protects the modules against the environment and 
35 makes it possible to place the modules separately. The 

modules are advantageously arranged physically separated. 
In this way, the modules may be easily spread out and 
placed in different places. In many cases, it is advan- 
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tageous to be able to spread out the modules in different 
places. The drive modules are preferably located as close 
to the motors as possible to obtain short cables which are 
less sensitive to EMC disturbances. In many branches of 
5 industry, there is a shortage of floor space due to com- 
pressed manufacturing cells and lines. With a drive system 
according to the invention, it is possible to place the 
various modules where there is free floor space. 

According to another embodiment of the invention, at least 
some of the modules are arranged to communicate via the 
Ethernet. Ethernet is a simple standard protocol. By ar- 
ranging the modules so that they can use the Ethernet, in- 
expensive standard components may be used. 

According to still another embodiment of the invention, the 
control system comprises at least three such modules. A 
control system may comprise many modules, of which some 
modules handle different functions and others handle the 
same function. It is thus possible that the control system 
may comprise several modules with the same function. By the 
characteristic feature that the control system comprises at 
least three modules is meant that the control system com- 
prises three modules irrespective of whether these handle 
different functions or the same function. 

An additional object of the invention is to suggest a 
method for controlling one or more manipulators. This 
object is achieved with a method that is characterized in 
3 0 that said one or more computers and drive units are ar- 
ranged in modules, that the modules are arranged with their 
own power supply, and that the modules are brought to com- 
municate with at least one of the other modules. The con- 
trol system is divided into a plurality of separate modules 
35 adapted to handle different functions, whereby the modules 
are provided with their own power supply and are brought to 
communicate with at least one of the other modules. 
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Although not explicitly described in the claims, the inven- 
tion also covers the method in combination with the charac- 
teristic features of the control system according to any of 
the appended claims. 

5 

BRIEF DESCRIPTION OF THE DRAWINGS 

The invention will now be explained in greater detail by 
means of various exemplary embodiments with reference to 
10 the accompanying drawing. 

Figure 1 shows a control system according to the prior art, 

Figure 2 shows a control system according to a first 
15 embodiment of the invention, 

Figure 3 shows a control system according to a second 
embodiment of the invention, 

20 Figure 4 shows the control system in greater detail. 

DESCRIPTION OF THE PREFERRED EMBODIMENTS 

Figure 1 shows a control system 1 according to the prior 
25 art, controlling three industrial robots 2. The control 

system 1 comprises a main computer 4, three axis computers 
6 and three drive units 8, each of which including a number 
of drives. Each drive unit 8 is connected to a robot 2 and 
supplies the robot with control signals and electric power. 
30 The main computer, the axis computers and the drive units 
are arranged together and constitute one unit that is en- 
closed by a common casing 10. The control .system has a 
common power- supply unit that produces voltages with the 
correct quality and with the correct level for all parts 
35 included in the control system. The main computer and the 
axis computers communicate with each other and with the 
drive units via an internal bus (not shown in the figure) . 
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A control system according to the invention comprises at 
least three separate modules, which are arranged to handle 
different functions. A plurality of different types of 
modules are available and each type of module has its own 
function. Each module has its own well-defined interface 
with respect to the other modules. When the modules are 
interconnected, they form a control system with all the 
functions of a conventional control system. The control 
system composed of the separate modules need not include 
all types of modules and may include several modules of the 
same type. The modules have their own power supply and are 
arranged so as to be able to communicate with at least one 
of the other modules. A plurality of the different types of 
modules are also provided with their own computer utility. 

Figure 2 shows a control system according to one embodiment 
of the invention, controlling three robots 2 . The figure 
shows four modules, one main-computer module 12 and three 
drive modules 14 . The control system also comprises other 
modules that are not shown in the figure. The main-computer 
module 12 comprises the main computer 4 of the control sys- 
tem and handles the functions of the main computer, such as 
executing robot programs and giving orders to the drive 
module regarding the movement of the robot, such as the 
desired position and speed. Each one of the drive modules 
14 comprises an axis computer 6 and a drive unit 8. The 
function of the drive module is to carry out the orders of 
the main computer so that the robot carries out the move- 
ment ordered. Each module 12, 14 is enclosed in its own 
casing 15 and constitutes a separate physical unit. Each 
one of the drive modules 14 is directly connected to the 
ma in -computer module and communicates therewith via an 
Ethernet link. 

Figure 3 shows another embodiment of a control system 
according to the invention, wherein the drive modules 14 
instead are arranged in series. The first drive module is 
connected to the main-computer module 12 and to the second 
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drive module, which in turn is connected to the third drive 
module. These connections comprise communication via the 
Ethernet. Electric power is transmitted separately to each 
module. 

5 

Figure 4 shows in more detail an embodiment of a control 
system according to the invention. The control system com- 
prises five different types of modules: one main-computer 
module 12, one drive module 14, one control' module 16, one 

10 transformer module 18, and one client I/O module 20. The 
main-computer module 12 includes the main computer, the 
communication card (RCC) of the robot, and one or more 
field bus cards. The main computer constitutes the centre 
of the system and it controls and reacts to communication 

15 from other parts of the system. The main computer executes 
robot programs and gives orders to the drive module regar- 
ding the position and speed of the robot. The drive module 
14 comprises a drive unit with up to nine drives, an axis 
computer and a contactor card. A drive module may thus 

20 drive a six-axis robot with three external axes. 



The control module 16 comprises an operating panel with 
built-in power supply and the control panel of the control 
system with an emergency- stop button and buttons for selec- 

25 ting various settings as well as a main switch. The control 
module 16 constitutes the centre of the safety functions of 
the robot and it supervises the whole safety chain. Most of 
the external safety signals for the robot are connected to 
the operating panel. The control module preferably includes 

30 a computer. A portable programming unit (TPU) 22 is also 

connected to the control module 16. The programming unit 22 
is used by an operator for programming the robot. The 
client I/O module comprises I/O panels and is adapted to 
receive electric equipment or other electronics. What type 

35 of electronics or equipment to install into the module is 
determined by the robot user. The equipment installed may, 
for example, be a welding machine or a painting machine. It 
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is possible for the user to make external changes in this 
module so as to suit the requirements of the user. 



The transformer module 18 comprises a transformer and a 
5 switch. The transformer module is supplied with ac voltage 
from the electricity network and transforms the ac voltage 
into the desired voltage level. The transformer module in 
turn supplies the other modules with ac voltage. All the 
modules have their own power supply, which means that they 
10 are provided with a power-supply unit 26 that converts in- 
coming alternating current into direct current and produces 
the voltages that are needed in the module. The power- 
supply units 2 6 produce voltages of the correct quality and 
of the correct level for its module. 

15 

Each one of the modules 12-20 is enclosed in a casing for 
protection against pollutants in the surroundings. The 
modules that are in need thereof are provided with their 
own cooling system. A voltage arriving at the transformer 

20 module 18 is transformed by the transformer into a suitable 
voltage level and is then supplied to the modules via the 
cables 24a-c connected to the power-supply unit 26 in the 
modules. In this embodiment, the main-computer module 12 
communicates with the control module 16 via an Ethernet 

25 cable 28a. The main-computer module 12 also communicates 
with the drive module 14 via an Ethernet cable 28b. The 
main computer supplies the axis computer in the drive 
module with new references every fourth ms . The main- 
computer module 12 and the client I/O module 2 0 are connec- 

3 0 ted to each other via a field bus 30. 

Which modules, and how many of each type, are included in 
the control system varies depending on the application. 
There should be at least a main-computer module, a drive 
3 5 module and a control module. The control system may have no 
or several transformer modules and no or several client I/O 
modules, respectively. In a small robot configuration, the 
transformer may instead be located in the drive module. 
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The invention is not limited to the embodiments shown but 
may be varied and modified within the scope of the appended 
claims. The division of the modules with respect to what 
functions they are to handle may be done in other ways than 
5 those shown in the above-described embodiments . The number 
of different types of modules may also vary. The principle 
for the division of the functions of the control system 
into different modules is that these functions are divided 
in such a way as to require as small an exchange of infor- 
10 mation between the modules as possible. In another embodi- 
ment of the invention, the drive module comprises only the 
axis computer and the drives are instead arranged on the 
robot adjacent to the motors. 
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